Stabilized Deteministic Optimization Based Control System and Method

ABSTRACT

The embodiments described herein include one embodiment that provides a control method, including determining a first stabilizing feasible control trajectory of a plurality of variables of a controlled process, determining a second stabilizing feasible control trajectory for the plurality of variables for a second time step subsequent to the first time step, determining a first cost of applying the first feasible control trajectory at the second time step, determining a second cost of applying the second feasible control trajectory at the second time step, comparing the first and second costs, selecting the first feasible control trajectory or the second feasible control trajectory based upon the comparison in a predetermined time frame, and controlling the controlled process by application of the selected control trajectory.

BACKGROUND

The invention relates generally to control systems and more particularly to deterministic optimization based control of systems.

Generally, control system, such as an industrial plant or a power generation system, may be dynamic and include various constraints. For example, the constraints on the control system may be the result of actuator limits, operational constraints, economical restrictions, and/or safety restrictions. Accordingly, control of such a multivariable constrained dynamic system may be complex. Techniques such as coupled multi-loop proportional-integral-derivative (PID) controllers may not be best suited for handling the control of such complex control systems. On the other hand, one process control technique capable of handling the multivariable constraints is optimization based control (OBC). Specifically, OBC may improve the performance of the control system by enabling the system to operate closer to the various constraints (i.e., via dynamic optimization).

However, OBC may be computationally demanding because the dynamic optimization calculation may involve solving a constrained optimization problem such as quadratic programming (QP) problems at each sampling time. Utilizing a general solver may take seconds or even minutes. In addition, it may be difficult to predict the time it takes for the optimizer to solve the constrained optimization problems. Accordingly, to utilize OBC to control systems with faster dynamics, it may often be beneficial to enable deterministic OBC to provide a feasible control action within a predetermined control time.

BRIEF DESCRIPTION

Certain embodiments commensurate in scope with the originally claimed invention are summarized below. These embodiments are not intended to limit the scope of the claimed invention, but rather these embodiments are intended only to provide a brief summary of possible forms of the invention. Indeed, the invention may encompass a variety of forms that may be similar to or different from the embodiments set forth below.

A first embodiment provides a control method including determining a first stabilizing feasible control trajectory of a plurality of variables of a controlled process, the first control trajectory being the same as or an extension of a control trajectory applied for a first time step, the trajectory extending over a plurality of future time steps after the first time step, determining a second stabilizing feasible control trajectory for the plurality of variables for a second time step subsequent to the first time step, determining a first cost of applying the first feasible control trajectory at the second time step, determining a second cost of applying the second feasible control trajectory at the second time step, comparing the first and second costs, selecting the first feasible control trajectory or the second feasible control trajectory based upon the comparison in a predetermined time frame, and controlling the controlled process by application of the selected control trajectory.

A second embodiment provides a control method, comprising a first stabilizing feasible control trajectory of a plurality of variables of a controlled process for a second time step within a predetermined time frame based upon a control trajectory applied for a first time step previous to the second time step, the trajectory extending over a plurality of future time steps after the first time step, applying an optimization-based control algorithm to determine a second feasible control trajectory for a second time step, selecting the first feasible control trajectory if a first cost of applying the first feasible control trajectory is less then a second cost of applying the second feasible control trajectory, or if the optimization-based control algorithm does not determine a second feasible control trajectory in a time allowed, and controlling the controlled process by application of the selected control trajectory.

A third embodiment provides a control system, including memory circuitry for storing executable code, and processing circuitry for executing the code. The code defining steps that, when executed determines a first stabilizing feasible control trajectory of a plurality of variables of a controlled process, the first control trajectory being the same as or an extension of a control trajectory applied for a first time step, the trajectory extending over a plurality of future time steps after the first time step, determines a second feasible control trajectory for the plurality of variables for a second time step subsequent to the first time step, determines a first cost of applying the first feasible control trajectory at the second time step, determines a second cost of applying the second feasible control trajectory at the second time step, compares the first and second costs, selects the first feasible control trajectory or the second feasible control trajectory based upon the comparison within a predetermined time frame, and controls the controlled process by application of the selected control trajectory.

DRAWINGS

These and other features, aspects, and advantages of the present invention will become better understood when the following detailed description is read with reference to the accompanying drawings in which like characters represent like parts throughout the drawings, wherein:

FIG. 1 depicts a block diagram of an embodiment of a control system utilizing deterministic optimization-based control (OBC);

FIG. 2 depicts a block diagram of an embodiment of the deterministic optimization-based control from FIG. 1;

FIG. 3 depicts a block diagram of an embodiment of the processing circuitry from FIG. 2;

FIG. 4 depicts an embodiment of a deterministic OBC module communicatively coupled to other modules within the control system.

FIG. 5A depicts an embodiment of a feasible search method for solving a quadratic programming problem that has found an optimum solution;

FIG. 5B depicts an embodiment of a feasible search method for solving the quadratic programming problem that has not found the optimum solution;

FIG. 5C depicts an embodiment of an infeasible search method for solving the quadratic programming problem that has found the optimum solution;

FIG. 6 depicts a block diagram of an embodiment of a stabilization process used in the optimization-based control;

FIG. 7A depicts a first feasible solution for the quadratic programming problem;

FIG. 7B depicts the first feasible solution advanced one step compared to a second feasible solution for the quadratic programming problem;

FIG. 8 depicts an embodiment of a process control utilizing the stabilization process depicted in FIG. 6;

FIG. 9 depicts an embodiment of dynamic optimization-based control (OBC) utilizing a steady state block, a dynamic target generator block, and a dynamic optimization block;

FIG. 10 depicts an embodiment of dynamic optimization-based control (OBC) utilizing a steady state block and a dynamic target generator block;

FIG. 11 depicts an embodiment of dynamic optimization-based control (OBC) utilizing a dynamic optimization block; and

FIG. 12 depicts an approximation based on control blocking compared to one based on linear control blocking;

FIG. 13A depicts an embodiment of complex constraints; and

FIG. 13B depicts and embodiments simple bound constraints acting as a funnel for the complex constraints.

DETAILED DESCRIPTION

One or more specific embodiments of the present invention will be described below. In an effort to provide a concise description of these embodiments, all features of an actual implementation may not be described in the specification. It should be appreciated that in the development of any such actual implementation, as in any engineering or design project, numerous implementation-specific decisions must be made to achieve the developers' specific goals, such as compliance with system-related and business-related constraints, which may vary from one implementation to another. Moreover, it should be appreciated that such a development effort might be complex and time consuming, but would nevertheless be a routine undertaking of design, fabrication, and manufacture for those of ordinary skill having the benefit of this disclosure.

When introducing elements of various embodiments of the present invention, the articles “a,” “an,” “the,” and “said” are intended to mean that there are one or more of the elements. The terms “comprising,” “including,” and “having” are intended to be inclusive and mean that there may be additional elements other than the listed elements.

The present disclosure is generally directed toward systems and methods for deterministic optimization-based control (OBC) of a control system, such as an industrial plant, a power generation system, or the like. Generally, control systems may utilize process control techniques to control the system. For example, some control systems utilize proportional-integral-derivative (PID) controllers coupled in a multi-loop configuration. Multi-loop PID controllers may offer a fast real-time control of a control system. In addition, PID controllers may run on embedded systems with less computational power. However, when control system has complex dynamics and/or its operation is constrained, the complexity of the process control may greatly increase and multi-loop PID controllers may not provide adequate control. For example, the control system may include processes with large dead times or non-minimum phase dynamics.

One process control technique for control of dynamic multivariable systems is optimization-based control (OBC), which can offer better control (e.g. reduces process variations to enable operation closer to constraints at more profitable operating points). Specifically, OBC uses a process model to predict future process output trajectories based on process input trajectories. In other words, OBC computes trajectories of manipulated variables to optimize the objective function (i.e., minimize costs). As used herein, the cost includes the determination of how well the output trajectories match the desired setpoints. It should be appreciated that in linear control systems, the cost may be captured as a quadratic programming (QP) problem. Accordingly, the dynamic optimization included in the OBC may be computationally complex and run on computer servers with general solvers, which may take seconds or even minutes to produce a solution. Thus, to include OBC on an embedded system for real-time process control, it may be beneficial to improve the efficiency of OBC while ensuring that it is stabilizing.

Accordingly, one embodiment provides a control method including determining a linear approximation of a pre-determined non-linear model of a process to be controlled, determining a convex approximation of the nonlinear constraint set, determining an initial stabilizing feasible control trajectory for a plurality of sample periods of a control trajectory, executing an optimization-based control algorithm to improve the initial stabilizing feasible control trajectory for a plurality of sample periods of a control trajectory, and controlling the controlled process by application of the feasible control trajectory within a predetermined time window. In other words, deterministic OBC may be utilized for real-time control of systems with fast dynamics by including a stabilization function to produce a stable feasible solution (i.e., a solution that does not increase the cost function) available for each predetermined sampling time.

By way of introduction, FIG. 1 depicts an embodiment of a control system 10 for a plant/process 12. Generally, the control system 10 may control the functioning of the plant/process 12, which may be an industrial manufacturing system, an automation system, a power generation system, a turbine system, or the like. Accordingly, as depicted, the control system 10 may control the plant/process 12 to transform material inputs 14 into material outputs 16. For example, the plant/process 12 may be a sugar crystallization process that transforms sugar syrup (i.e., material input 14) into sugar crystals (i.e., material output 16). In addition, the control system 10 may control the output variables (i.e., controlled variables) 18 by manipulating the input variables 20 (i.e., manipulated and disturbance variables). Going back to the sugar crystallization example, the control system 10 may manipulate a steam valve (i.e., manipulated variable) to control a temperature (i.e., controlled variable). In some embodiments, the material input can be a manipulated variable as well (for example a controller can control the feed rate for a material input to the plant).

To optimize the control of the plant/process 12, the control system 10 may further include optimization based control (OBC) 22 configured to find a stabilizing feasible solution for an optimization problem within a predetermined time window. In other words, the OBC 22 may determine feasible actions (i.e., solution) for the control system 10 to take. Specifically, the OBC 22 may be configured to determine a control trajectory 26 (i.e., a set of actions) over a control horizon (i.e., period of time to take the actions). Accordingly, the OBC 22 may sample the state of the plant/process 12 at specified sampling times. In some embodiments, the state of the plant/process 12 may include the previous output variables 18, a desired output trajectory 23, a desired control trajectory 24, or any combination thereof. Based on the sampled state of the plant/process 12, the OBC 22 may determine the control trajectory 26 (i.e., a feasible solution to the optimization problem) during the control time. As used herein, control time refers to the time during which the plant/process 12 is functioning, which may be in real-time. After the control trajectory 26 is determined by the OBC 22, in some embodiments, the control trajectory 26 is compared to the desired control trajectory 24 in a comparator 32 to determine the input variables 20 to the plant/process 12 (i.e., actions to be taken in the control system 10). Alternatively, the control trajectory 26 may be directly reflected in the input variables 20. It should be appreciated that the OBC 22 may be implemented on an embedded system, such as ControlLogix, available from available from Rockwell Automation, of Milwaukee, Wis.

To facilitate determining the control trajectory 26, as depicted, the OBC 22 includes a pre-determined model 28 and a deterministic solver 30. Specifically, the deterministic solver 30 may use a feasible search strategy, such as a primal active set method, to determine solutions to the constrained optimization problem. As will be described in more detail below, a feasible search strategy begins at a starting point within the feasible region of the control system 10 and moves around the feasible region to search for an optimum feasible solution (i.e., control trajectory with minimum cost). In other words, the deterministic solver 30 may determine various feasible actions (i.e., control trajectories) that may be taken by the control system 10. Based on the feasible solutions determined by the deterministic solver 30, the model 28 may be utilized to predict the behavior of the process/plant 12. In linear systems or non-linear systems with a linear approximation, the model 28 may be a linear model such as a state space model, a step or impulse response model, an autoregressive with exogenous terms (ARX) model, a transfer function model, or the like. As such, the OBC 22 may compare the cost of each feasible solution and select the control trajectory 26 with the lowest cost.

Ideally, the control trajectory 26 determined is the optimum solution with the lowest cost associated, but, as described above, the optimization calculation may be complex. Accordingly, as will be described in further detail below in the Detailed Example section, the techniques described herein aim to increase the efficiency of the dynamic optimization calculation. For example, the techniques described herein may modify an objective (i.e., cost) function to define the control system 10 constraints with simple bounds. Thus, the dynamic optimization computation may be greatly reduced and executed on an embedded system because many dynamic optimization solvers (e.g., quadratic-programming (QP) solvers) more efficiently handle simple bounds compared to complex constraints.

Although the dynamic optimization may be efficiently configured, the OBC 22 may not always find the optimum (i.e., lowest cost) control trajectory 26 during each control time. However, in practice, a stable sub-optimal control trajectory 26 may be sufficient. As used herein, the control trajectory 26 is stabilizing when the cost does not increase compared to the previous step by taking the actions.

To facilitate the functions described herein, it should be appreciated that the OBC 22 may include a processor, useful for executing computing instructions (i.e., steps), and memory, useful for storing computer instructions (i.e., code) and/or data. As depicted in FIG. 2, the OBC 22 may implement the processor through processing circuitry 34 and the memory through memory circuitry 36. More specifically, the processing circuitry 34 may be configured to handle the general functionality of the control system, such as controlling actuators, as well as the functions of OBC 22, such as dynamic optimization. In addition, as depicted in FIG. 3, the processing circuitry 34 may include multiple processing components (e.g., parallel processor cores or separate processor modules), which may enable the processing circuitry 34 to better manage various functions. For example, as depicted, a first processing component 38 may perform the general operations of the control system 10. The general operations of the control system 10 may include controlling components of the control system 10, performing calculations, and the like. As for the OBC 22 functions, the computationally intensive dynamic optimization may be performed on the second processing component 40. Accordingly, this enables the dynamic optimization to be called from the first processing component 38 and executed synchronously or asynchronously on the second processing component 40, which may improve the efficiency of the optimization calculation. Alternatively, it should be appreciated that the dynamic optimization may be performed on the first processing core 38 along with the general functions of the control system 10. Furthermore, as depicted, the processing circuitry 34 includes N processing components, which may each be configured to handle different functions, such as calculating a linear approximation, of the control system 10.

Turning back to FIG. 2, the memory circuit 36 may store computer instructions (i.e., code) describing the model 28, the deterministic solver 30, configuration parameters 42, as well as other instructions 44, such as computing virtual measurements for unmeasured process variables for the general functioning of the control system 10. Specifically, the instructions stored in the memory circuit may be configured to guide the functioning of the model 28 and the deterministic solver 30. Accordingly, the memory circuitry 36 is communicatively coupled to the processing circuitry 34 to enable to processing circuitry 36 to read and/or execute the instructions (i.e., steps).

Furthermore, the depicted embodiment of the OBC 22 further includes an output interface 46, a user interface 48, a network interface 50, and a feedback interface 52. Specifically, the user interface 48 may be configured to enable a user to communicate with the OBC 22. For example, as depicted in FIG. 4, the user interface 48 may include a graphical-user-interface (GUI) 54 configured to display metrics of the OBC 22, such as the control trajectory 26 determined. In addition, the user interface 48 may include buttons 56, which enable the user to input commands to the OBC 22. Similar to the user interface 48, the network interface 50 may enable a user to communicate with the OBC 22 over a network 58, such as a wide-area-network (WAN). In some embodiments, the network 58 may be a EtherNet/IP Network or a ControlNet Network, available from Rockwell Automation, of Milwaukee, Wis. More specifically, as depicted in FIG. 4, the network interface 50 may be communicatively coupled to the network 58 via a communication module 60. Alternatively, the network interface 50 may be communicatively coupled directly the network 58 through the backplane of the OBC 22. Furthermore, as depicted, the network 58 may be communicatively coupled to a remote monitoring/control system 62, such as a supervisory control and data acquisition (SCADA), to enable the user to remotely communicate with the OBC 22. Accordingly, as depicted in FIG. 2, both the user interface 48 and the network interface 50 are communicatively coupled to the processing circuitry 34 to enable user commands to be communicated to the processing circuitry 34 and information concerning the OBC 22 to be communicated to the user. Note that each module in memory circuitry 36 may be configured such that it can respond as a server responding to the queries from various interfaces. For example, the model module 28 can be queried by the user interface to report its fidelity. In addition the model module 28 may be called by solver code module 30 to determine the optimal control trajectory.

Turning back to FIG. 2, as described above, the OBC 22 may be configured determine stabilizing feasible control trajectories for the control system 10 based on feedback from the plant/process 12. As such, the feedback interface 52 may be configured to receive feedback, such as the previous output variables 18, the desired output trajectory 23, the desired control trajectory 24, or any combination thereof, and communicate it to the processing circuitry 34. For example, the feedback interface 52 may be a serial port located on the backplane of the OBC 22, which enables the OBC 22 to receive samples from sensors in the control system 10. After the processing circuitry 34 determines a control trajectory 26, the control trajectory 26 is communicated to the output interface 46. As will be described in more detail below, the processing circuitry 34 may utilize various search functions (e.g., QP solvers) and stabilization functions to determine the control trajectory 26. Thus, the output interface 46 may be configured to transmit the control trajectory 26 to the plant/process 12. Similar to the feedback interface 52, the output interface 46 may be a serial port located on the backplane of the OBC 22 to enable the output interface to communicate with a controller controlling inputs into the plant/process 12. It should be appreciated that as described above, the controller may be the same processing component, a different core of a processor, or a different processor module.

As described above, the processing circuitry may utilize various search methods to facilitate determining a control trajectory 26 (i.e., dynamic optimization). Examples of such search methods are depicted in FIGS. 5A-5C. Included in each figure, as depicted, is a feasible region 64 and an infeasible region 66. More specifically, the feasible region 64 is all of the solutions or control trajectories 26 that do not violate the constraints of the control system 10. On the other hand, the solutions or control trajectories 66 in the infeasible region violate the constraints of the control system 10 and are infeasible. As depicted, constraints are depicted as constraint lines 68, which separate the feasible region 64 and the infeasible region 66. As described above, the constraints may be the result of actuator limits, technological restrictions, economical restrictions, and/or safety restrictions.

As described above, the processing circuitry 34 may utilize various solver methods (i.e., algorithms) to facilitate determining a control trajectory 26 (i.e., dynamic optimization). Examples of such solver methods are depicted in FIGS. 5A-5C. Included in each figure, as depicted, is a feasible region 64 and an infeasible region 66. More specifically, the feasible region 64 is all of the solutions or control trajectories 26 that do not violate the constraints of the control system 10. On the other hand, the solutions or control trajectories 66 in the infeasible region violate the constraints of the control system 10 and are infeasible. As depicted, constraints are depicted as constraint lines 68, which separate the feasible region 64 and the infeasible region 66. As described above, the constraints may be the result of actuator limits, technological restrictions, economical restrictions, and/or safety restrictions.

Specifically, FIGS. 5A and 5B depict feasible search methods (i.e., algorithms) and FIG. 5C depicts an infeasible search method (i.e., algorithms). However, it should be appreciated that the figures are not meant to depict any particular search method or algorithm and are merely illustrative. As depicted in both FIG. 5A and FIG. 5B, the feasible search method begins from a feasible point 70 within the feasible region 64. From the starting feasible point 70, the feasible search method moves around the feasible region 64 searching for the optimum solution (i.e., control trajectory) 72 during the control time. In some cases, as shown in FIG. 5A, an optimum control trajectory 72 is found. In others, as shown in FIG. 5B, a suboptimal but still feasible control trajectory 74 is found. An example of a feasible search method is a primal active set solver method (i.e., algorithm). Comparatively, as depicted in FIG. 5C, the infeasible search method begins from an infeasible point 76 within the infeasible region 66. From the starting infeasible point 76, the infeasible search method determines infeasible solutions until it converges on the optimum solution (i.e., control trajectory) 72. An example of an infeasible search method is a dual active set solver method. Accordingly, it should be appreciated that, if terminated before the optimum control trajectory 72 is found, the feasible search method will produce a feasible control trajectory, but the infeasible search method may produce an infeasible control trajectory.

In addition, as described above, the dynamic optimization (e.g., feasible search method or infeasible search method) may be run asynchronously from the rest of the control system 10. Thus, if a less than optimum control trajectory is found during the control time, the optimization may continue into the following control times, which gives the OBC 22 more time for complex optimization calculations. Furthermore, when the optimum trajectory 72 is found, it may be time shifted, padded, and included in future optimization calculations.

Because in some embodiments the dynamic optimization calculation may find a suboptimal control trajectory 74 during the control time, a stabilization process 78 may be useful to stabilize the control system 10. In other words, the stabilization process 78 may be configured to reduce the risk that the cost of the control system 10 will increase because of the suboptimal control trajectory 74. As depicted in FIG. 6, the stabilization process 78 may begin by computing a feasible solution or control trajectory (process block 80). The feasible solution may be calculated in various manners. For example, as will be described in more detail below, a steady state optimization method may be used. Alternatively, other search methods, such as the primal active set solver method, may be used.

To stabilize the control system 10, the feasible solution determined in process block 80 (i.e., first stabilizing control trajectory) may be compared to a previous solution (i.e., second stabilizing control trajectory) determined in process block 84. More specifically, the previous solution is advanced, which may include shifting and padding, to the next control time (process block 86). As an example, FIG. 7A depicts a control trajectory 88 with a control horizon of six (i.e., six time steps) determined at a time i. As described above, the control trajectory 88 represents a setting of a manipulated variable, such as the percent a valve is open. Accordingly, based on the control trajectory 88, the control system 10 will take a first action 90 for the control time between time i and time i+1. At time i+1, the first action 90 has been performed. Thus, as depicted in FIG. 7B, the remaining control trajectory 88 (i.e., trajectory between time i+1 and time i+6) is time shifted to form a previous solution 92. In addition, because the control horizon for the time shifted control trajectory is five (i.e., five time steps), the previous solution is 92 is padded with an additional control system action 94. In some embodiments, this may include repeating the last control system action 96. Furthermore, FIG. 7B depicts a newly calculated solution 98, such as by process block 80, represented by the dashed line. Accordingly, the previous solution 92 may be compared to the newly calculated solution 98.

Turning back to FIG. 6, after the previous solution 92 and the newly calculated solution 98 are adjusted to the same control horizon, one characteristic to be compared may be the cost of each. Accordingly, based on the objective (i.e., cost) function, the cost for the newly calculated solution 98 (process block 99) and the cost of the previous solution 92 may be calculated (process block 100). Next, the cost of the new solution 98 is compared with the cost of the previous solution 92 (process block 102). Finally, the solution (i.e., control trajectory) with the lowest cost may be selected (process block 104).

As will be described in more detail below, the selected control trajectory may be utilized by the control system 10 to control the plant/process 12 by applying the selected control trajectory. For example, the selected control trajectory may be used directly to control the manipulated variables 20 input into the plant/process 12. Alternatively, as depicted in FIG. 8 the selected control trajectory may be used to in a stable deterministic optimization based control (OBC) process (i.e., algorithm) 106, which may be implements in the OBC 22. Beginning the process 106, user-defined setpoints 107 and/or feasible targets (i.e., infeasible setpoints mapped into feasible region) 108 may be input into an initial (i.e., upstream) processing, which may be configured to determine a feasible solution or control trajectory (process block 110). As described above, the initial processing (process block 110) may utilize any method to determine a feasible solution (i.e., control trajectory). Next the stabilization process may stabilize the control system 10 (process block 78). The solution selected by the stabilization process 78, may then be used to initialize a dynamic optimization (process block 112). This may be helpful especially when input into a feasible search method, which utilizes a feasible starting solution. For example, as will be described in more detail in the Detailed Example section, initializing a primal active set solver method (i.e., algorithm) with the solution selected by the stabilization process 78 may increase the efficiency of the optimization search 112. Finally, based on the control trajectory determined by the optimization search 112, the manipulated variables 20 input into the plant/process 12 may be controlled (process block 114).

FIGS. 9-11 depict different embodiments of OBCs 22 utilizing the stable deterministic optimization based process control 106. Included in the three embodiments are three optional and configurable blocks: a steady state optimization block 116, a dynamic target generation block 118, and a dynamic optimization block 120. Accordingly, a user may choose an appropriate configuration of the OBC 22 that fits the specific needs of particular application in terms of closed loop performance, robustness and/or execution speed.

The steady state optimization block 116 can have two different purposes. The first goal of the steady state optimization block 116 is to find the most profitable steady-state control target based on the model 28 and the user-defined setpoints 107. The second goal of the steady state optimization block 116 is to find feasible steady-state targets that are as close to infeasible setpoints as possible, which may then be used in the dynamic optimization 112. In some embodiments, the steady-state target is a control trajectory with a single operating point. Furthermore, in some embodiments, the steady state optimization block 116 may account for control variable zones. In other words, a zone setpoint instead of a particular point. More specifically, the steady state optimization block may utilize soft constraints.

The dynamic target generation block 118 may be configured to generate feasible dynamic control trajectories based on the user-defined setpoints 107, feasible targets 108, and/or the steady-state targets. Accordingly, the effect of procrastination may be reduced and robustness may be satisfactory. As used herein, procrastination refers to a predicted control trajectory that is infeasible and thus not applied. For example, the dynamic target generation block 118 may be configured to generate feasible control trajectories by starting at each infeasible setpoint and terminating at the feasible target 108. In addition, the dynamic optimization block 120 may be configured to implement the dynamic optimization process 112. Furthermore, as depicted in FIGS. 9-11, each embodiment includes the stabilization process 78.

FIG. 9 depicts an embodiment including the steady state optimization block 116, the dynamic target generation block 118, and the dynamic optimization block 120. In the depicted embodiment, the steady state optimization block 116, using a primal active set solver method (i.e., algorithm), is configured to determine steady-state targets 124. Next, the dynamic target generation block 118 is configured to generate, by filter combining, a feasible dynamic control trajectory 126. Accordingly, in the present embodiment, the steady state optimization block 116 and the dynamic optimization block 120 make up the initial processing 110. Thus, the stabilization process 78 may stabilize the control system 10 as described above. Based on the output (i.e., selected feasible control trajectory) from the stabilization process 78, the dynamic optimization block 120 may attempt to find the optimum solution (i.e., control trajectory). For example, the depicted embodiment uses the primal active set solver method (i.e., algorithm) 122. The OBC 22 embodiment depicted in FIG. 9 may be the most universal but the slowest configuration.

FIG. 10 depicts an embodiment including the steady state optimization block 116 and the dynamic target generation block 118. Similar to the embodiment depicted in FIG. 9, the depicted embodiment the steady state optimization block generates the steady state targets 124, the dynamic target generation block 118 generates a feasible dynamic control trajectory 126, and the stabilization process 78 stabilizes the control system 10. In this embodiment, the feasible control trajectory selected by the stabilization process 78 is directly passed to the control system 10. The OBC 22 embodiment depicted in FIG. 10 may be a good option for time critical applications.

FIG. 11 depicts an embodiment including the dynamic optimization block 120. In the depicted embodiment, the stabilization process 78 uses the user-inputted setpoint 107 as a control trajectory. Similar to the embodiment depicted in FIG. 9, based output from the stabilization process 78, the dynamic optimization block 120 may attempt to find the optimum solution (i.e., control trajectory). The OBC 22 embodiment depicted in FIG. 11 may be used for small scale applications with good closed loop performance.

DETAILED EXAMPLE

Below is a detailed example to help illustrate the techniques taught herein. First, as described above, the efficiency of the OBC 22 may be increased by simplifying the dynamic optimization calculation. In some embodiments, this may include simplifying the model 28. Generally, the model 28 may be expressed as a standard formula.

y=A _(u) Δu+y _(free)  (1)

where

Δu=[(Δu₁)^(T),(Δu₂)^(T), . . . , (Δu_(n) _(u) )^(T)]^(T)—future changes of all inputs arranged in a vector

Δu_(n)=[Δu_(n) (t),Δu_(n) (t+1), . . . , Δu_(n) (t+n_(c)−1)]^(T)—future changes of n-th input

y=[(y₁)^(T),(y₂)^(T), . . . , (y_(n) _(y) )^(T)]^(T)—all predicted output trajectories arranged in a vector

y_(j)=[y_(j) (t+1), . . . , y_(j) (t+p)]^(T)—predicted trajectory of j-th output

y_(free)=[(y_(free) ¹)^(T),(y_(free) ²)^(T), . . . , (y_(free) ^(n) ^(y) )^(T)]^(T)—all free response trajectories arranged in a vector

y_(free) ^(j)=[y_(free) ^(j) (t+1), . . . , y_(free) ^(j) (t+p)]^(T)—free response trajectory of j-th output

n_(u)—number of inputs

n_(y)—number of outputs

n_(c)—control horizon

p—prediction horizont

N=n_(c)—number of control moves

Specifically, the standard formula (equation 1) reflects the superposition principle: the total future response (i.e., output trajectory) is a sum of responses to future inputs and responses to past inputs, disturbances, and initial conditions (i.e., y_(free)). The response y_(free), may be updated at each sample time according to particular model structure. Accordingly, the predicted output trajectory of the j-th output may be expressed similar to equation 1.

y _(j) =A _(uj) Δu+y _(free) ^(j)  (2)

where

A_(uj)=[A_(uj) ¹, A_(uj) ², . . . , A_(uj) ^(n) ^(u) ]—prediction matrix of j-th output

A_(u)=[A_(u1) ^(T), A_(u2) ^(T), . . . , A_(un) _(y) ^(T)]^(T)—prediction matrix

Furthermore, the following equation represents the changes of inputs (i.e., incremental inputs).

Δu(k)=u(k)−u(k−1)  (3)

In addition, the following represent the absolute inputs.

u _(n) =[u _(n)(t),u _(n)(t+1), . . . ,u _(n)(t+n _(c)−1)]^(T)—future trajectory of n-th input

u=[(u ₁)^(T), . . . ,(u ₂)^(T), . . . ,(u _(n) _(u) )^(T)]^(T)—all future input trajectories arranged in a vector)  (4)

Thus, to help simplify the above equations, relative inputs may be used instead of incremental inputs. Specifically, the constraints may be simplified and the Hessian matrix may be better conditioned. As used herein u_(r) represents the relative input and is defined as difference from current value of input. Accordingly, u_(r) may be expressed as follows.

u _(ri)(k)=u _(i)(k)−u _(0i)  (5)

where

u_(ri)—i-th relative input

u_(0i)=u_(i)(t−1)—current value of the i-th input

Based on the definition of u_(n), equation (5) may alternatively expressed as follows.

u _(ri) =u _(i)−1u _(0i),1^(T)=[1,1, . . . 1]^(T)  (6)

Thus, the linear transformation between the relative input (u_(r)) and the incremental input (Δu) is as follows.

$\begin{matrix} {{{{\Delta \; {u_{i}(k)}} = {{{u_{i}(k)} - {u_{i}\left( {k - 1} \right)}} = {{\Delta \; {u_{ri}(k)}} = {{u_{ri}(k)} - {u_{ri}\left( {k - 1} \right)}}}}}{{u_{ri}(k)} = {\sum\limits_{j = t}^{k}{\Delta \; {u_{i}(j)}}}}{u_{ri} = {S\; \Delta \; u_{i}}},{S = \begin{bmatrix} 1 & 0 & 0 & \ldots & 0 \\ 1 & 1 & 0 & \; & 0 \\ 1 & 1 & 1 & \; & 0 \\ \vdots & \; & \; & \ddots & 0 \\ 1 & 1 & 1 & 1 & 1 \end{bmatrix}},{{\Delta \; u_{i}} = {{S\;}^{- 1}u_{ri}}},{S^{- 1} = \begin{bmatrix} 1 & 0 & 0 & \ldots & 0 \\ {- 1} & 1 & 0 & \; & 0 \\ 0 & {- 1} & 1 & \; & 0 \\ \vdots & \; & \; & \ddots & \vdots \\ 0 & 0 & \ldots & {- 1} & 1 \end{bmatrix}}}{{{\Delta \; u} = {{S\;}_{c}^{- 1}u_{r}}},{S_{c}^{- 1} = \begin{bmatrix} S^{- 1} & 0 & \ldots & 0 \\ 0 & S^{- 1} & \; & 0 \\ \vdots & \; & \ddots & \; \\ 0 & 0 & \; & S^{- 1} \end{bmatrix}},{u_{r} = {S_{c}\Delta \; u}},{S_{c} = \begin{bmatrix} S & 0 & \ldots & 0 \\ 0 & S & \; & 0 \\ \vdots & \; & \ddots & \; \\ 0 & 0 & \; & S \end{bmatrix}}}{{u_{r} = {u = {I_{c}u_{0}}}},{I_{c} = \begin{bmatrix} 1 & 0 & \ldots & 0 \\ 0 & 1 & \; & 0 \\ \vdots & \; & \ddots & \; \\ 0 & 0 & \; & 1 \end{bmatrix}},{u_{0} = \begin{bmatrix} u_{01} \\ u_{02} \\ \vdots \\ u_{0n_{u}} \end{bmatrix}}}{u = {{S_{c}\Delta \; u} + {I_{c}u_{0}}}}} & (7) \end{matrix}$

Accordingly, the model 28 (i.e., equation 1) based on the relative input may be expressed as follows.

y=A _(u) Δu+y _(free)=(A _(u) S _(c) ⁻¹)u _(r) +y _(free) =A _(r) u _(r) +y _(free)  (8)

To further simplify and improve the model 28, linear control blocking may be utilized. Generally, control blocking may simplify model 28 by changing control inputs at specified control times (i.e., t+c_(j)). In other words, control blocking results in a piece-wise constant control trajectory. To better approximate general smooth control trajectories linear control blocking may be utilized. Specifically, linear control blocking may result in a piece-wise linear control trajectory while the number of decision variables remains the same. For example, as in FIG. 12, the break points 128 of the piece-wise linear trajectory 130 is specified at the following sample times (t+k₁), (t+k₂), . . . , (t+k_(N)) where k₁=0 and k_(N)=n_(c)−1. The decision vector for implementing linear control blocking (u_(L)) is given by the values of relative input (u_(r)) at the specified sample times.

u _(L) =[u _(r)(t),u _(r)(t+k ₂), . . . ,u _(r)(t+k _(N))]^(T)  (9)

Accordingly, the values between the break points 128 may be calculated by linear interpolation as follows.

$\begin{matrix} {{u_{r}(i)} = \left\{ {{\begin{matrix} {{{- \frac{i - \left( {t + k_{j + 1}} \right)}{k_{j + 1} - k_{j}}}{u_{L}\left( {t + k_{j}} \right)}} + {\frac{i - \left( {t + k_{j}} \right)}{k_{j + 1} - k_{j}}{u_{L}\left( {t + k_{j + 1}} \right)}}} & {{i \in \left\lbrack {{t + k_{j}},{t + k_{j + 1}}} \right\rbrack},} \\ {{u_{L}\left( {t + k_{N}} \right)},} & {i \in \left\lbrack {{t + k_{N} + 1},{t + p - 1}} \right\rbrack} \end{matrix}j} = {{1\mspace{14mu} \ldots \mspace{14mu} Nu_{r}} = \left\lbrack {{u_{r}(t)},{u_{r}\left( {t + 1} \right)},\ldots \mspace{14mu},{u_{r}\left( {t + p - 1} \right)}} \right\rbrack^{T}}} \right.} & (10) \end{matrix}$

Accordingly, a model using control blocking is represented by control trajectory 132 and a model using linear control blocking is represented by control trajectory 134. It follows that u_(r)(i) can be expressed as a linear combination of the break point values as follows.

$\begin{matrix} {{{u_{r}(i)} = {\sum\limits_{j = 1}^{N}{f_{ij}{u_{L}\left( {t + k_{j}} \right)}}}}{f_{ij} = \left\{ {{\begin{matrix} {- \frac{i - \left( {t + k_{j + 1}} \right)}{k_{j + 1} - k_{j}}} & {i \in \left\lbrack {{t + k_{j}},{t + k_{j + 1}}} \right\rbrack} \\ \frac{i - \left( {t + k_{j - 1}} \right)}{k_{j} - k_{j - 1}} & {i \in \left\lbrack {{t + k_{j - 1}},{t + k_{j}}} \right\rbrack} \\ 1 & {i \in \left\lbrack {{t + k_{N} + 1},{t + p - 1}} \right\rbrack} \\ 0 & {otherwise} \end{matrix}f_{iN}} = \left\{ {{\begin{matrix} \frac{i - \left( {t + k_{N - 1}} \right)}{k_{N} - k_{N - 1}} & {i \in \left\lbrack {{t + k_{N - 1}},{t + k_{N}}} \right\rbrack} \\ 1 & {i \in \left\lbrack {{t + k_{N} + 1},{t + p - 1}} \right\rbrack} \\ 0 & {otherwise} \end{matrix}j} = {{1\mspace{14mu} \ldots \mspace{14mu} N} - 1}} \right.} \right.}} & (11) \end{matrix}$

And, in matrix notation we get the following formula.

u _(r) =Fu _(L) ,F(i,j)=f _(ij)  (12)

As a result, the model 28 may be expressed in the following way without increasing the number of decision variables.

y=A _(u) Δu+y _(free) =A _(u) S ⁻¹ u _(r) =y _(free) =A _(u) S ⁻¹ Fu ^(L) +y _(free)

A _(L) =A _(u) S ⁻¹ F

y=A _(L) u _(L) =y _(free)  (13)

In addition to simplifying the model 28, the cost function (i.e., objection function) may also be simplified to enhance the efficiency of the OBC 22. Generally, a quadratic objective function may be expressed as follows.

$\begin{matrix} {J_{y} = {{\sum\limits_{j = 1}^{n_{y}}{\left( {y_{j} - y_{j}^{t}} \right)^{T}{W_{j}\left( {y_{j} - y_{j}^{t}} \right)}}} + {\sum\limits_{n = 1}^{n_{u}}{\Delta \; u_{n}^{T}B_{n}\Delta \; u_{n}}} + {\sum\limits_{n = 1}^{n_{u}}{\left( {u_{n} - u_{n}^{T}} \right)^{T}{V_{n}\left( {u_{n} - u_{n}^{t}} \right)}}}}} & (14) \end{matrix}$

where

W_(j), B_(n), V_(n)—positive semidefinite weight matrices (tuning parameters)

y_(j) ^(t)=[y_(j) ^(t)(t+1), y_(j) ^(t)(t+2), . . . , y_(j) ^(t)(t+p)]^(T)—output target trajectory

u_(n) ^(t)=[u_(n) ^(t)(t+1), u_(n) ^(t) (t+2), . . . , u_(n) ^(t) (t+p)]^(T)—input target trajectory

Using standard algebraic manipulation the objective function can be transformed to the following quadratic form.

J _(y)(Δu)=½Δu^(T) G _(y) Δu+f _(y) ^(T) Δu+C  (15)

where G_(y) is Hessian, f_(y) is a linear term and C is constant term that can be omitted for optimization. We assume that B_(n) matrices are positive definite and so G_(y) is also positive definite.

One of the most important features of OBC is that it can handle constraints. The constraints for the n-th input may be represented as follows.

i=0 . . . n _(c)−1:

u _(min)(n)≦u _(n)(t+i)≦u _(max)(n)—simple bounds

Δu _(min)(n)≦Δu _(n)(t+i)≦Δu _(max)(n)—rate of change constraints  (16)

In a compact form, the constraints may be represented as follows.

Δu _(max) =[Δu _(max)(1), . . . ,Δu _(max)(n _(u))]^(T)

Δu _(min) =[Δu _(min)(1), . . . ,Δu _(min)(n _(u))]^(T)

I _(c) Δu _(min) ≦Δu≦I _(c) Δu _(max)

u _(max) =[u _(max)(1), . . . ,u _(max)(n _(u))]^(T)

u _(min) =[u _(min)(1), . . . ,u _(max)(n _(u))]^(T)

u _(min) ≦u≦u _(max)

u _(min) ≦S _(c) Δu+I _(c) u ₀ ≦u _(max)

I _(c)(u _(min) −u ₀)≦S _(c) Δu≦I _(c)(u _(max) −u ₀)  (17)

In some cases, controlled variable (i.e., output) may lie within a specific range (i.e., between y_(min) and y_(max)). This formulation may lead to more robust and less aggressive control actions but may also results in a more complex optimization calculation. However, if the optimization calculation has hard constraints on outputs, then an infeasible control trajectory may be found. Accordingly, soft constraints with slack variables may be used. However, in order to not to dramatically increase number of decision variables or number of complex constraints, the optimization calculation may be simplified by only adding one additional variable with simple bounds per constrained output. This additional variable may be interpreted as an optimized target that must lie within the specific output range (i.e., between y_(min) and y_(max)). For example, output target trajectory y^(t) may be defined by an additional decision variable z and the constrained outputs may be defined by n_(z) with indices k₁ . . . k_(nz). Accordingly, objective function and constraints may be defined as follows.

$\begin{matrix} {\begin{matrix} {{J_{z}\left( {{\Delta \; u},z} \right)} = {\sum\limits_{i = 1}^{n_{z}}{\left( {y_{k_{i}} - {1z_{i}}} \right)^{T}{M_{i}\left( {y_{k_{i}} - {1z_{i}}} \right)}}}} \\ {= {{\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}^{T}{G_{z}\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}}} + {f_{z}^{T}\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}} + C}} \end{matrix}{y_{\min} \leq z \leq y_{\max}}{{1 = \left\lbrack {1,1,{\ldots \mspace{14mu} 1}} \right\rbrack^{T}},{z = \left\lbrack {z_{1},z_{2},{\ldots \mspace{14mu} z_{n_{z}}}} \right\rbrack^{T}}}{{y_{\max} = \left\lbrack {{y_{\max}(1)},\ldots \mspace{14mu},{y_{\max}\left( n_{z} \right)}} \right\rbrack^{T}},{y_{\min} = \left\lbrack {{y_{\min}(1)},\ldots \mspace{14mu},{y_{\min}\left( n_{z} \right)}} \right\rbrack^{T}}}} & (18) \end{matrix}$

Furthermore, because overall objective function J is then sum J=J_(y)+J_(z) the optimization calculation may be as follows.

$\begin{matrix} {{{\min\limits_{{\Delta \; u},z}{J\left( {{\Delta \; u},z} \right)}} = {{\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}^{T}{G\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}}} + {f^{T}\begin{bmatrix} {\Delta \; u} \\ z \end{bmatrix}} + C}}{{I_{c}\Delta \; u_{\min}} \leq {\Delta \; u} \leq {I_{c}\Delta \; u_{\max}}}{{I_{c}\left( \; {u_{\min} - u_{0}} \right)} \leq {S_{c}\Delta \; u} \leq {I_{c}\; \left( {u_{\max} - u_{0}} \right)}}{z_{\min} \leq z \leq z_{\max}}} & (19) \end{matrix}$

Using the transformation Δu=S_(c) ⁻¹u_(r) in equation (7), the optimization problem based on relative inputs (u_(r)) is as follows.

$\begin{matrix} {{{\min\limits_{u,z}{J_{r}\left( {u_{r},z} \right)}} = {{\begin{bmatrix} u_{r} \\ z \end{bmatrix}^{T}{G_{r}\begin{bmatrix} u_{r} \\ z \end{bmatrix}}} + {f_{r}^{T}\begin{bmatrix} u_{r} \\ z \end{bmatrix}}}}{{I_{c}\left( {u_{m\; i\; n} - u_{0}} \right)} \leq u_{r} \leq {I_{c}\left( {u_{{ma}\; x} - u_{0}} \right)}}{{I_{c}\Delta \; u_{m\; i\; n}} \leq {S_{c}^{- 1}u_{r}} \leq {I_{c}\Delta \; u_{m\; {ax}}}}{z_{m\; i\; n} \leq z \leq z_{{ma}\; x}}} & (20) \end{matrix}$

Accordingly, taking advantage of that fact that feasible search method more efficiently hand simple bound constraints as compared to complex constraints 136 (e.g., a rate of change constraint), depicted in FIG. 13A, the simple bound constraints 138 may be configured to act as a funnel as depicted in FIG. 13B. Thus, the simple bounds may be expressed as follows.

$\begin{matrix} {{n = {1\mspace{14mu} \ldots \mspace{14mu} n_{u}\text{:}}}{{{u_{m\; {ax}}^{rn}(i)} = {\min \left( {{{u_{{ma}\; x}(n)} - {u_{0}(n)}},{{i \cdot \Delta}\; {u_{{ma}\; x}(n)}}} \right)}},{i = {1\mspace{14mu} \ldots \mspace{14mu} n_{c}}}}\underset{\_}{{u_{m\; i\; n}^{rn}(i)} = {\max \left( {{{u_{m\; i\; n}(n)} - {u_{0}(n)}},{{{- i} \cdot \Delta}\; {u_{m\; i\; n}(n)}}} \right)}}{{u_{{ma}\; x}^{rn} = \left\lbrack {{u_{{ma}\; x}^{rn}(1)},\ldots \mspace{14mu},{u_{{ma}\; x}^{rn}\left( n_{c} \right)}} \right\rbrack^{T}},{u_{m\; {ax}}^{r} = \left\lbrack {\left( u_{{ma}\; x}^{r\; 1} \right)^{T},\ldots \mspace{14mu},\left( u_{{ma}\; x}^{{rn}_{u}} \right)^{T}} \right\rbrack^{T}}}{{u_{m\; i\; n}^{rn} = \left\lbrack {{u_{{ma}\; x}^{rn}(1)},\ldots \mspace{14mu},{u_{{ma}\; x}^{rn}\left( n_{c} \right)}} \right\rbrack^{T}},{u_{m\; i\; n}^{r} = \left\lbrack {\left( u_{m\; i\; n}^{r\; 1} \right)^{T},\ldots \mspace{14mu},\left( u_{m\; i\; n}^{{rn}_{u}} \right)^{T}} \right\rbrack^{T}}}} & (21) \end{matrix}$

Thus, the optimization calculation may be expressed as follows.

$\begin{matrix} {{{\min\limits_{u_{r},z}{J_{r}\left( {u_{r},z} \right)}} = {{\begin{bmatrix} u_{r} \\ z \end{bmatrix}^{T}{G_{r}\begin{bmatrix} u_{r} \\ z \end{bmatrix}}} + {f_{r}^{T}\begin{bmatrix} u_{r} \\ z \end{bmatrix}}}}{u_{m\; i\; n}^{r} \leq u_{r} \leq u_{m\; {ax}}^{r}}{{{I_{c}\Delta \; u_{m\; i\; n}} \leq {Ru}_{r} \leq {I_{c}\Delta \; u_{{ma}\; x}}},{z_{m\; i\; n} \leq z \leq z_{{ma}\; x}}}{{R = \begin{bmatrix} R_{u} & 0 & \ldots & 0 \\ 0 & R_{u} & \; & 0 \\ \vdots & \; & \ddots & \; \\ 0 & 0 & \; & R_{u} \end{bmatrix}},{R_{u} = \begin{bmatrix} {- 1} & 1 & 0 & \; & 0 \\ 0 & {- 1} & 1 & \; & 0 \\ \; & \; & \; & \ddots & \vdots \\ 0 & 0 & \ldots & {- 1} & 1 \end{bmatrix}},}} & (22) \end{matrix}$

Furthermore, using a common variable x=[u_(r) ^(T), z^(T)]^(T) with n elements we get the following resulting optimization problem in a standard form as follows.

$\begin{matrix} {{{\min\limits_{x}{J_{r}(x)}} = {{x^{T}G_{r}x} + {f_{r}^{T}x}}}{x_{m\; i\; n} \leq x \leq x_{m\; {ax}}}{{\Delta \; x_{m\; i\; n}} \leq {Rx} \leq {\Delta \; x_{{ma}\; x}}}{{R = \begin{bmatrix} R_{u} & 0 & \ldots & 0 \\ 0 & R_{u} & \; & 0 \\ \vdots & \; & \ddots & \; \\ 0 & 0 & \; & R_{u} \end{bmatrix}},{R\text{:}{n_{u}\left( {N - 1} \right)} \times n},{R_{u} = \begin{bmatrix} {- 1} & 1 & 0 & \; & 0 & \ldots & 0 \\ 0 & {- 1} & 1 & \; & 0 & \; & 0 \\ \; & \; & \; & \ddots & \vdots & \; & \; \\ 0 & 0 & \ldots & {- 1} & 1 & \; & 0 \end{bmatrix}},{R_{u}\text{:}\left( {N - 1} \right) \times n}}{n = {{n_{u}N} + n_{z}}}} & (23) \end{matrix}$

where

n—number of decision variables (length of x)

n_(u)—number of inputs (manipulated variables)

N—number of control moves (blocks) per control input

n_(z)—number of constrained outputs (controlled variables)

R—delta constraints

It should be notes that the constraints include both a lower and upper bound (bl≦C^(T)x≦bu). Accordingly the constraints may be expressed as follows.

$\begin{matrix} {\left. \begin{matrix} {x_{\min} \leq x \leq x_{\max}} \\ {{\Delta \; x_{\min}} \leq {Rx} \leq {\Delta \; x_{\max}}} \end{matrix}\Leftrightarrow{{bl} \leq {C^{T}x} \leq {bu}}\Leftrightarrow{{{bl}(i)} \leq {c_{i}^{T}x} \leq {{bu}(i)}} \right.,\mspace{79mu} {i = {1\mspace{14mu} \ldots \mspace{14mu} m}}} & (24) \end{matrix}$

However, the sign of the dual variables (u) corresponding to constraints with active upper bounds may be changed. As used herein, a dual variable may be a Laplace multiplier. The Lagrange condition for optimum is then that all dual variables are nonnegative or equivalently dual variables corresponding to active lower bounds are nonnegative and dual variables corresponding to active upper bounds are non-positive. Furthermore, sets are defined as follows.

K={1,2, . . . m}—set of all constraints

A⊂K—a subset of constraints

|A|—number of constraints in A

Accordingly, the active set is a subset A⊂K which includes the constraints that are satisfied at the current point (x). In other words, for all i∈A either c_(i) ^(T)x=bl(i) or c_(i) ^(T)x=bu(i). In addition, a set of active normal vectors may be defined as N_(A)={c_(i); i∈A} and the active matrix as N=[n₁, . . . n_(q)] composed of all active normal vectors n_(k)=C_(i) _(k) ∈N_(A)·A unique correspondence may be found between indices k and i_(k) given by an index table I_(A): i_(k)=I_(A)(k). At the current point the following equality may exist where b is composed of the corresponding components of bl and bu.

N ^(T) x=b  (25)

Furthermore, To recognize if the active constraint corresponds to an upper or lower bound we define a vector of flags sf_(A) as follows.

$\begin{matrix} {{{sf}_{A}(k)} = \left\{ {{\begin{matrix} {- 1} & {{{if}\mspace{14mu} n_{k}^{T}x} = {{bl}\left( {I_{A}(k)} \right)}} \\ 0 & {otherwise} \end{matrix}k} = {1\mspace{14mu} \ldots \mspace{14mu} q}} \right.} & (26) \end{matrix}$

Next, the efficiency of the search method utilized in the dynamic optimization 112 may be improved. As described above, one optimization search method that may be utilized is the primal active set solver method. Generally, a primal active set solver method starts from a feasible starting point; however, this may be computationally complex. Accordingly, by exploiting the structure of the optimization calculation, it may be beneficial to simplify finding a feasible starting point.

For example, a good candidate for a feasible starting candidate may be an unconstrained optimum as follows.

x _(u) =−G ⁻¹ f=−U ^(−T) U ⁻¹ f  (27)

Next, the bounds for x_(u) may be clipped to satisfy the simple bounds as follows.

$\begin{matrix} {{{{}_{}^{}{}_{}^{}}(i)} = \left\{ {{\begin{matrix} {x_{{ma}\; x}(i)} & {{{if}\mspace{14mu} {x_{u}(i)}} > {x_{{ma}\; x}(i)}} \\ {x_{m\; i\; n}(i)} & {{{if}\mspace{14mu} {x_{u}(I)}} < {x_{m\; i\; n}(i)}} \\ {x_{u}(i)} & {otherwise} \end{matrix}i} = {1\mspace{14mu} \ldots \mspace{14mu} n}} \right.} & (28) \end{matrix}$

Finally, x_(u) may be clipped to satisfy delta constraints as follows.

$\begin{matrix} {\;^{‘}{{x_{cu}(i)} = \left\{ {{\begin{matrix} {x_{s}(1)} & {{{if}\mspace{14mu} i} = 1} \\ {{x_{cu}\left( {i - 1} \right)} + {\Delta \; {x_{{ma}\; x}(i)}}} & {{{if}\mspace{14mu} {x_{s}(i)}} > {{x_{cu}\left( {i - 1} \right)} + {\Delta \; {x_{{ma}\; x}(i)}}}} \\ {{x_{cu}\left( {i - 1} \right)} - {\Delta \; {x_{m\; i\; n}(i)}}} & {{{if}\mspace{14mu} {x_{s}(i)}} < {{x_{cu}\left( {i - 1} \right)} - {\Delta \; {x_{m\; i\; n}(i)}}}} \\ {x_{s}(i)} & {otherwise} \end{matrix}\mspace{20mu} i} = {1\mspace{14mu} \ldots \mspace{14mu} n}} \right.}} & (29) \end{matrix}$

Optionally, further element-wise optimization may be performed. Specifically, when at a point x with gradient g=g(x), element-wise optimization may begin by updating x as follows.

′x(i)=x(i)−g(i)/G(i,i),i=1 . . . n  (30)

Calculating the gradient will be discussed in more detail below. Next, ′x may again be clipped. This procedure may be repeated a predefined number of times. The resulting point may then be used to stabilize the control system 10 as described above.

Similarly, calculating an initial active set may be computationally complex. Accordingly, to simplify the calculation, artificial simple bounds may be used. With a feasible point x₀, the active set may be initialized with n simple bounds as follows.

N=I _(n) ,N _(A) ={e _(k) ,k=1 . . . n}  (31)

where e_(k) is k-th column of identity matrix

Thus, when x₀(k)=x_(min)(k) the k-th constraint is k-th lower bound, when x₀(k)=x_(max)(k) the k-th constraint is k-th upper bound, and when x_(min)(k)<x₀(k)<x_(max)(k) the k-th constraint corresponds to an artificial bound x₀(k)≦x(k)≦x₀(k). During the course of the primal active set solver, the artificial bounds may be deleted from the active set regardless of the sign of the corresponding dual variables. Combining the artificial simple bounds with the initial active set, N=I_(nxq) (0≦q≦n). If q=n the full active set is used. If q=0 an empty active set is used. A good tradeoff may be k=[q/2].

Further efficiency enhancements may be made to the primal active set solver method. For example, rotations may be used to simplify an active set (i.e., constraints) matrix A. Specifically, factorization may be used to rotate the active set matrix when a constraint is added or deleted from active set. The described stable implementation is based on a modified Cholesky factorization of the Hessian matrix G where U is an upper triangular matrix.

G=UU ^(T)  (32)

Thus, the modified Cholesky factorization may be computed using a standard Cholesky factorization and a permutation matrix P as follows.

$\begin{matrix} {{{PGP}^{T} = {L_{2}L_{2}^{T}}}{{G = {UU}^{T}},{U = {P^{T}L_{2}P}},{P = \begin{bmatrix} \; & \; & \; & ⋰ \\ 0 & 0 & 1 & \; \\ 0 & 1 & 0 & \; \\ 1 & 0 & 0 & \; \end{bmatrix}}}} & (33) \end{matrix}$

As described in equation (33) the Hessian matrix is first permuted. Then the standard Cholesky factorization is calculated. Finally, the triangular matrix is permuted to get matrix U. Accordingly the following factorization of the matrix U⁻¹N⁺, where T⁺ is an upper triangular matrix, may be used.

$\begin{matrix} {{{\left( M^{+} \right)^{T}U^{- 1}N^{+}} = \begin{bmatrix} T^{+} \\ 0 \end{bmatrix}}{{\left( M^{+} \right)^{T}M^{+}} = D^{- 1}}{D = {{{diag}\left( {d_{1},d_{2},{\ldots \mspace{14mu} d_{n}}} \right)} = {\begin{bmatrix} D_{1} & 0 \\ 0 & D_{2\;} \end{bmatrix}\begin{matrix} {{\} q}\mspace{40mu}} \\ {{\} n} - q} \end{matrix}}}}} & (34) \end{matrix}$

Furthermore, the J⁺ matrix may be calculated by the following equation.

$\begin{matrix} {J^{+} = {{U^{- T}M^{+}} = {\begin{bmatrix} {L^{- T}M_{1}^{+}} & {L^{- T}M_{2}^{+}} \end{bmatrix} = \begin{bmatrix} \underset{q}{\underset{}{J_{1}^{+}}} & \underset{\underset{n - q}{}}{J_{2}^{+}} \end{bmatrix}}}} & (35) \end{matrix}$

The matrices J+, T+, D play a key role as they are may be used for the dynamic optimization calculation. The described factorization has advantage of upper triangularity of matrix U⁻¹. Thus when N⁺ is composed of an initial part of an identity matrix the factorization is readily available.

As described above, plane rotations may be performed when a constraint is added or removed from the active set. For example, constraint p may be removed from the active set because the corresponding dual variable u_(p) is negative. Furthermore, the following matrix structure is assumed.

N ⁺ =[N ₁ n _(p) N ₂ ],N=[N ₁ N ₂],  (36)

Matrix N⁺ may first be reordered so that normal n_(p) is moved to the last column as follows.

N _(r) ⁺ =[N ₁ N ₂ n _(p)]  (37)

Thus, the triangularity of the matrix T⁺ may be affected as follows.

$\begin{matrix} {{\left( J^{+} \right)^{T}N_{r}^{+}} = {{\begin{bmatrix} T_{H}^{+} \\ 0 \end{bmatrix}\begin{matrix} {{\} q}\mspace{40mu}} \\ {{\} n} - q} \end{matrix}} = {\begin{bmatrix} T_{1} & S & t_{p\; 1} \\ 0 & V & t_{p\; 2} \\ 0 & 0 & 0 \end{bmatrix}\begin{matrix} \begin{matrix} {{{\} p} - 1}\mspace{40mu}} \\ {{\} q} - p + 1} \end{matrix} \\ {{{\} n} - q}\mspace{45mu}} \end{matrix}}}} & (38) \end{matrix}$

In order to restore its upper triangularity, a set of plane rotations Q may be applied to upper Hessenberg sub-matrix [V t_(p2)] where γ is scalar.

$\begin{matrix} {{{Q\begin{bmatrix} V & t_{p\; 2} \end{bmatrix}} = \begin{bmatrix} T_{2} & d_{1} \\ 0 & \gamma \end{bmatrix}},{T_{r}^{+} = {{\begin{bmatrix} I & 0 \\ 0 & Q \end{bmatrix}T_{H}^{+}} = {\begin{bmatrix} T_{1} & S & d_{1} \\ 0 & T_{2} & \; \\ 0 & 0 & \gamma \end{bmatrix} = \begin{bmatrix} T & d_{1} \\ 0 & \gamma \end{bmatrix}}}},{d = \begin{bmatrix} d_{1} \\ \gamma \end{bmatrix}}} & (39) \end{matrix}$

To nullify elements under the main diagonal, the rotations may be applied to matrix rows in the following order: (1,2), (2,3), . . . (q−p, q−p+1). The same set of plane rotations Q may be applied to corresponding columns (p,p+1), . . . (q−1,q) of matrix J⁺ as follows.

$\begin{matrix} {{J^{+} = {\begin{bmatrix} \underset{q}{\underset{}{J_{1}^{+}}} & \underset{n - q}{\underset{}{J_{2}^{+}}} \end{bmatrix} = \begin{bmatrix} \underset{p}{\underset{}{J_{11}^{+}}} & \underset{q - p}{\underset{}{J_{12}^{+}}} & \underset{n - q}{\underset{}{J_{2}^{+}}} \end{bmatrix}}}{J = {\begin{bmatrix} \underset{q}{\underset{}{\begin{matrix} J_{11}^{+} & {J_{12}^{+}Q^{T}} \end{matrix}}} & \underset{n - q}{\underset{}{J_{2}^{+}}} \end{bmatrix} = \begin{bmatrix} \underset{q - 1}{\underset{}{J_{1}}} & \underset{n - q + 1}{\underset{}{J_{2}}} \end{bmatrix}}}} & (40) \end{matrix}$

Furthermore, utilizing the dual variable u_(p) corresponding to active constraint n_(p), may facilitate finding the optimum solution as follows.

z=−J(:,q+1)D(q+1,q+1)γu _(p)  (41)

As used herein, z refers to a step toward the optimum solution in a primal space. In addition, the number constraints in the active set may be decremented as follows.

q=q−1  (42)

Then, when a full step may be applied, the factorization for the reduced active set may be immediately available and the following updates may be made.

$\begin{matrix} {{A^{+} = A},{N^{+} = N},{T^{+} = {T_{r}^{+}\left( {{1\text{:}q},{1\text{:}q}} \right)}},{J^{+} = {J = \begin{bmatrix} \underset{q}{\underset{}{J_{1}^{+}}} & \underset{n - q}{\underset{}{J_{2}^{+}}} \end{bmatrix}}}} & (43) \end{matrix}$

Finally, equation (41) may be updated accordingly.

z=−J ⁺(:,q+1)D(q+1,q+1)T ⁺(q+1,q+1)u _(p)  (44)

On the other hand, constraints may also be added to the active set. For example, constraint n_(k) may be added to active set as follows.

A ₂ =AU{k},N ₂ =[N n _(k) ],A ⁺ =A ₂ U{P},N ⁺ =[N ₂ n _(p)]  (45)

To update the matrix T_(r) ⁺, the last column d is shifted to the right and a new column h is put in its place as follows.

$\begin{matrix} {{{N^{+}\begin{bmatrix} N & n_{k} & n_{p} \end{bmatrix}}{u_{p} = {\left( {1 - t} \right)u_{p}}}{T_{r}^{+} = \left\lbrack {{T_{r}^{+}\left( {\text{:},{1\text{:}q}} \right)},h,d} \right\rbrack}{{h = {{J^{T}n_{k}} = {\begin{bmatrix} h_{1} \\ h_{2} \end{bmatrix}\begin{matrix} {{\} q}\mspace{40mu}} \\ {{\} n} - q} \end{matrix}}}},{d = {\begin{bmatrix} d_{1} \\ d_{2} \end{bmatrix}\begin{matrix} {{\} q}\mspace{40mu}} \\ {{\} n} - q} \end{matrix}}},{d_{2} = {\underset{n - q}{\underset{}{\begin{bmatrix} \gamma & 0 & \ldots & 0 \end{bmatrix}}}\,^{T}}}}}\;} & (46) \end{matrix}$

Similar to removing a constraint, for the new active set, a sequence of rotations Q may be applied to restore the triangularity. Based on the structure of the T_(r) ⁺, it may be sufficient to nullify all but the first element of the vector h₂. Specifically, the rotations may be applied in the planes (n-q, n-q-1), (n-q-1, n-q-2), . . . (2, 1) as follows.

$\begin{matrix} {{h_{2} = {{\begin{bmatrix} x \\ x \\ x \\ x \end{bmatrix}->{\begin{bmatrix} x \\ x \\ y \\ 0 \end{bmatrix}->{\begin{bmatrix} x \\ z \\ 0 \\ 0 \end{bmatrix}->\begin{bmatrix} \alpha \\ 0 \\ 0 \\ 0 \end{bmatrix}}}} = \overset{\_}{h_{2}}}}{d_{2} = {{\begin{bmatrix} x \\ 0 \\ 0 \\ 0 \end{bmatrix}->{\begin{bmatrix} x \\ 0 \\ 0 \\ 0 \end{bmatrix}->{\begin{bmatrix} x \\ 0 \\ 0 \\ 0 \end{bmatrix}->\begin{bmatrix} a \\ b \\ 0 \\ 0 \end{bmatrix}}}} = \overset{\_}{d_{2}}}}} & (47) \end{matrix}$

After these rotations applied to T_(r) ⁺, the resulting triangular matrix is denotes as T⁺. If fast rotations are applied then also corresponding diagonal elements of matrix D are updated. The same set of rotations may be applied to the columns of matrix J⁺ as follows.

$\begin{matrix} {{{{{\left. {{Qh}_{2} = \begin{bmatrix} \alpha \\ 0 \end{bmatrix}} \right\} n} - q} = \overset{\_}{h_{2}}},{{Qd}_{2} = \overset{\_}{d_{2}}}}{J = \begin{bmatrix} \underset{\underset{q}{}}{J_{1}^{+}} & \underset{\underset{n - q}{}}{J_{2}^{+}Q^{T}} \end{bmatrix}}} & (48) \end{matrix}$

After the above operations, the number of active constraints and notation of matrices may be updated as follows.

$\begin{matrix} {{q = {q + 1}},{J^{+} = {J = \begin{bmatrix} \underset{\underset{q}{}}{J_{1}^{+}} & \underset{\underset{n - q}{}}{J_{2}^{+}} \end{bmatrix}}},} & (49) \end{matrix}$

Thus, equation (41) may be updated accordingly.

z=−J ⁺(:,q+1)D(q+1,q+1)T ⁺(q+1,q+1)u _(p)  (50)

Further improvements to the efficiency of the OBC 22, and more specifically the dynamic optimization 112, may be made by exploiting the structure of the optimization calculation. For example, computing the maximum step size. One part of calculating the maximum step size that may be computationally complex is evaluating constraints (i.e., computing scalar product n^(T)z). However, this calculation may be reduced by exploiting the special structure of the constraints. For example, constraints with simple bounds and corresponding slack may be evaluated as follows where e_(j) is j-th column of identity matrix I).

$\begin{matrix} {{n^{T} = {e_{j}^{T} = \begin{bmatrix} {0{\ldots 0}} & \underset{\underset{j}{}}{1} & {0{\ldots 0}} \end{bmatrix}^{T}}}{{n^{T}z} = {z(j)}}{{s_{\min} = {{x(j)} - {x_{\min}(j)}}},{s_{\max} = {{x_{\max}(j)} - {x(j)}}}}} & (51) \end{matrix}$

Similarly, delta constraints (R) may be efficiently evaluated as follows.

$\begin{matrix} {\mspace{79mu} {{n^{T} = {\Delta_{j} = \begin{bmatrix} {0{\ldots 0}} & \underset{\underset{j - 1}{}}{- 1} & \underset{\underset{j}{}}{1} & {0{\ldots 0}} \end{bmatrix}^{T}}}\mspace{79mu} {{n^{T}z} = {{z(j)} - {z\left( {j - 1} \right)}}}{{s_{\min} = {{x(j)} - {x\left( {j - 1} \right)} - {\Delta \; x_{\min}}}},{s_{\max} = {{\Delta \; x_{\max}} - {x(j)} + {x\left( {j - 1} \right)}}}}}} & (52) \end{matrix}$

The structure of the optimization calculation may also be exploited to resolve degeneracy. As used herein, degeneracy refers to linearly dependent constraints in the active set. Accordingly, to avoid adding linearly dependent constraint, the step direction may be refined to reduce round-off errors. For example, if a simple bound constraint e_(k) is active then corresponding element of step direction z(k) must be zero. Moreover, if a delta constraint Δ_(k) is active then z(k)=z(k−1). Similarly if neighboring delta constraints Δ_(k), Δ_(k+1) are active then z(k+1)=z(k)=z(k−1).

Specifically, a change of delta constraints may be as follows.

Chain_(ij)={Δ_(k) ;i≦k≦j,Δ _(k) ∈N _(A),Δ_(i−1) ∉N _(A),Δ_(j+1) ∉N _(A)}  (53)

An example of active constraints corresponding to a chain is below.

$\begin{matrix} {N = \begin{bmatrix} {- 1} & 0 & 0 & 0 \\ 1 & {- 1} & 0 & 0 \\ 0 & 1 & {- 1} & 0 \\ 0 & 0 & 1 & 0 \end{bmatrix}} & (54) \end{matrix}$

If there is also active simple bound with index inside a chain then the fixed chain may be defined as follows.

FixedChain_(ijr)={Δ_(k);Δ_(k)∈Chain_(ij) ,∃r:i−1≦r≦j,e _(r) ∈N _(A)}  (55)

An example of active constraints corresponding to a fixed chain is below.

$\begin{matrix} {N = \begin{bmatrix} {- 1} & 0 & 0 & 0 \\ 1 & {- 1} & 1 & 0 \\ 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 0 \end{bmatrix}} & (56) \end{matrix}$

Based on these definitions a refine function (Ref) may be defined as follows.

$\begin{matrix} {z_{r} = {{{{Ref}(z)}:{z_{r}(i)}} = \left\{ \begin{matrix} 0 & {e_{i} \in N_{A}} \\ 0 & {\Delta_{i} \in {FixedChain}} \\ 0 & {\Delta_{i + 1} \in {FixedChain}} \\ {z\left( {i - 1} \right)} & {\Delta_{i} \in {Chain}} \\ {z(i)} & {Otherwise} \end{matrix} \right.}} & (57) \end{matrix}$

Thus, the Ref function may prevent adding linearly dependent constraints and so resolve degeneracy.

The structure of the optimization calculation may still further be exploited to calculate the dual variables. Based on the structure of the constraints, the dual variables may calculated directly from the definition. As used herein, a dual variable u corresponds to an active constraint n may be denoted as u_(d)(n). If a simple constraint e_(k) is active and neither Δ_(k) nor Δ_(k+1) are active then corresponding dual variable is u_(d)(e_(k))=g_(k). If a delta constraint Δ_(k) is active and neither Δ_(k−1) nor e_(k−1) are active then we can put u_(d)(Δ_(k))=−g_(k−1). If a chain of delta constraints Chain_(ij) is active then calculate dual variables for delta constraints i . . . j. This may be accomplished through various methods. For example, the dual variables may be calculated using the following equation.

$\begin{matrix} {{{u_{d}\left( \Delta_{i} \right)} = {- g_{i - 1}}}{{u_{d}\left( \Delta_{i + 1} \right)} = {{u_{d}\left( \Delta_{i} \right)} - g_{i}}}{{u_{d}\left( \Delta_{i + 2} \right)} = {{u_{d}\left( \Delta_{i + 1} \right)} - g_{i + 1}}}\vdots {{u_{d}\left( \Delta_{j} \right)} = {{u_{d}\left( \Delta_{j - 1} \right)} - g_{j - 1}}}} & (58) \end{matrix}$

Alternatively, the dual variables may be calculated using the following equation.

$\begin{matrix} {{{u_{d}\left( \Delta_{j} \right)} = g_{j}}{{u_{d}\left( \Delta_{j - 1} \right)} = {{u_{d}\left( \Delta_{j} \right)} + g_{j - 1}}}{{u_{d}\left( \Delta_{j - 2} \right)} = {{u_{d}\left( \Delta_{j - 1} \right)} - g_{j - 2}}}\vdots {{u_{d}\left( \Delta_{i} \right)} = {{u_{d}\left( \Delta_{i + 1} \right)} - g_{i}}}} & (59) \end{matrix}$

Or, the dual variables calculated in equation (58) and equation (59) may be averaged. Similarly, various methods may be used when a chain of fixed delta constraints FixedChain_(ijr) is active. For example, the dual variables may be calculated for delta constraints i . . . r using equation (58). Alternatively, the dual variables may be calculated for delta constraints r+1 . . . j using equation (59). Furthermore, the dual variables may be calculated for e_(r): u_(d)(e_(r))=g_(r)+u_(d)(Δ_(r+1))−u_(d)(Δ_(r)).

As seen in equation (58) and equation (59), the dual variable calculation may utilize gradients. Instead of calculating the absolute value of the gradient it may be more efficient to update it in every step as follows.

$\begin{matrix} {{{\Delta \; g} = {{G\; \Delta \; x} = {\sum\limits_{i = 1}^{n}\; {{G\left( {\text{:},i} \right)}\Delta \; {x(i)}}}}},{{\Delta \; x} = {tz}}} & (60) \end{matrix}$

It follows from the structure of the constraints that if simple bound e_(k) is active then corresponding element Δx(k)=0. Similarly, if a fixed chain FixedChain_(ijr) is active then corresponding elements Δx(k)=0, k=i . . . j. Furthermore, if a Chain_(ij) is active then Δx(k)=Δx(i), k=i . . . j. Thus, multiplication operations may be saved as follows.

$\begin{matrix} {{\sum\limits_{k = i}^{j}\; {{G\left( {\text{:},k} \right)}\Delta \; x\; (k)}} = {\Delta \; {x(i)}{\sum\limits_{k = i}^{j}\; {G\left( {\text{:},k} \right)}}}} & (61) \end{matrix}$

As such, the computation of dual variable may be accomplished with only elements k of the gradient that correspond to a simple bound e_(k) or a chain Chain_(ij) or a fixed chain FixedChain_(ijr) with i≦k≦j, which may save other operations. A set of indices of gradient may be updated. If a new constraint is added to the active set, then the corresponding absolute element of the gradient g(k) may be calculated and the next steps we just update it through Δg(k).

In case of adding simple bound e_(k), the vector h is simply k-th column of the matrix J^(T).

$\begin{matrix} {{J^{T}e_{k}} = {{J^{T}\left( {\text{:},k} \right)} = {h = {\begin{bmatrix} h_{1} \\ h_{2} \end{bmatrix}\begin{matrix} {\} q} \\ {{\} n} - q} \end{matrix}}}}} & (62) \end{matrix}$

In case of adding delta constraint Δ_(k), the vector h may simply be the difference of the k-th and (k−1)-th columns of the matrix J^(T).

$\begin{matrix} {{J^{T}\Delta_{k}} = {{{J^{T}\left( {\text{:},k} \right)} - {J^{T}\left( {\text{:},{k - 1}} \right)}} = {h = {\begin{bmatrix} h_{1} \\ h_{2} \end{bmatrix}\begin{matrix} {\} q} \\ {{\} n} - q} \end{matrix}}}}} & (63) \end{matrix}$

The matrix J=U^(−T) is initially lower triangular. For every column J(:,k) of the matrix J an integer number (o_(k)) that corresponds to a number of zeros in the initial part of the vector may be store and maintain. In other words, J(i,k)=0 for i=1 . . . o_(k). Plane rotation may then be applied to two neighboring columns J(:,k) and J(:,k+1) as follows.

$\begin{matrix} {{\left\lbrack {{J\left( {\text{:},k} \right)}\mspace{31mu} {J\left( {\text{:},{k + 1}} \right)}} \right\rbrack Q^{T}} = {{{\begin{matrix} 1 \\ \vdots \\ o_{k} \\ \; \\ \; \end{matrix}\begin{bmatrix} 0 & 0 \\ \vdots & \vdots \\ 0 & 0 \\ x & 0 \\ x & x \end{bmatrix}}Q^{T}} = \begin{bmatrix} 0 & 0 \\ \vdots & \vdots \\ 0 & 0 \\ y & y \\ y & y \end{bmatrix}}} & (64) \end{matrix}$

It should be appreciated that o_(k)+1 . . . n may be rotated. After the rotation, the integer o_(k+1) may be incremented.

Furthermore, it may also possible to take advantage of the special sparse structure of the matrix J in the procedure of adding constraint. For example, when adding simple bound e_(k) or delta constraint Δ_(k) there is good chance, in the early stages of the optimization calculation, that m last elements of the vector h₂ are zeros. For each column of the matrix J a variable that stores the number of zeros in the initial part of the column may be defined. When two columns are rotated these numbers are used to calculate an initial index from which to start rotations. Accordingly unnecessary operations may be avoided.

Generally, the above techniques enable deterministic optimization control to be used with plants/process 12 with fast dynamics. More specifically, the OBC 22 is configured to provide a stable feasible control trajectory during each control time, which may include comparing the cost of feasible solutions (i.e., control trajectory) to the cost of previous solutions. Furthermore, techniques are described herein to improve the efficiency of the OBC 22 by simplifying complex calculations, such as dynamic optimization.

While only certain features of the invention have been illustrated and described herein, many modifications and changes will occur to those skilled in the art. It is, therefore, to be understood that the appended claims are intended to cover all such modifications and changes as fall within the true spirit of the invention. 

1. A control method, comprising: determining a first stabilizing feasible control trajectory of a plurality of variables of a controlled process, the first control trajectory being the same as or an extension of a control trajectory applied for a first time step, the trajectory extending over a plurality of future time steps after the first time step; determining a second stabilizing feasible control trajectory for the plurality of variables for a second time step subsequent to the first time step; determining a first cost of applying the first feasible control trajectory at the second time step; determining a second cost of applying the second feasible control trajectory at the second time step; comparing the first and second costs; selecting the first feasible control trajectory or the second feasible control trajectory based upon the comparison in a predetermined time frame; and controlling the controlled process by application of the selected control trajectory.
 2. The method of claim 1, wherein the first feasible control trajectory is determined by application of an optimization-based control algorithm.
 3. The method of claim 2, wherein the optimization-based control algorithm comprises a feasible optimization search.
 4. The method of claim 3, wherein the feasible optimization search comprises a primal active set solver algorithm.
 5. The method of claim 1, wherein the first feasible control trajectory comprises a shifted and padded version of the control trajectory applied at the first time step.
 6. The method of claim 1, wherein the second feasible control trajectory is determined by application of an optimization-based control algorithm.
 7. The method of claim 6, wherein the optimization-based control algorithm comprises a feasible optimization search.
 8. The method of claim 7, wherein the feasible optimization search comprises a primal active set solver algorithm.
 9. The method of claim 1, comprising cyclically repeating the steps during real-time control of the controlled process.
 10. The method of claim 1, wherein the first feasible control trajectory is determined by moving at least one infeasible variable value to a feasible region although the resulting first feasible control trajectory is sub-optimal.
 11. The method of claim 1, wherein the second feasible control trajectory is determined by moving at least one infeasible variable value to a feasible region although the resulting second feasible control trajectory is sub-optimal.
 12. A control method, comprising: a first stabilizing feasible control trajectory of a plurality of variables of a controlled process for a second time step within a predetermined time frame based upon a control trajectory applied for a first time step previous to the second time step, the trajectory extending over a plurality of future time steps after the first time step; applying an optimization-based control algorithm to determine a second feasible control trajectory for a second time step; selecting the first feasible control trajectory if a first cost of applying the first feasible control trajectory is less then a second cost of applying the second feasible control trajectory, or if the optimization-based control algorithm does not determine a second feasible control trajectory in a time allowed; and controlling the controlled process by application of the selected control trajectory.
 13. The method of claim 12, wherein the first feasible control trajectory is determined by application of an optimization-based control algorithm.
 14. The method of claim 13, wherein the optimization-based control algorithm comprises a feasible optimization search.
 15. The method of claim 14, wherein the feasible optimization search comprises a primal active set solver algorithm.
 16. The method of claim 12, wherein the first feasible control trajectory comprises a shifted and padded version of the control trajectory applied at the first time step.
 17. The method of claim 12, wherein the optimization-based control algorithm comprises a feasible optimization search.
 18. The method of claim 17, wherein the feasible optimization search comprises a primal active set solver algorithm.
 19. A control system, comprising: memory circuitry for storing executable code, and processing circuitry for executing the code, the code defining steps that, when executed: determines a first stabilizing feasible control trajectory of a plurality of variables of a controlled process, the first control trajectory being the same as or an extension of a control trajectory applied for a first time step, the trajectory extending over a plurality of future time steps after the first time step; determines a second feasible control trajectory for the plurality of variables for a second time step subsequent to the first time step; determines a first cost of applying the first feasible control trajectory at the second time step; determines a second cost of applying the second feasible control trajectory at the second time step; compares the first and second costs; selects the first feasible control trajectory or the second feasible control trajectory based upon the comparison within a predetermined time frame; and controls the controlled process by application of the selected control trajectory.
 20. The system of claim 19, wherein the processing circuitry comprises a multi-core processor, and wherein one core of the multi-core processor is dedicated to determining the feasible control trajectories and another core of the multi-core processor performs other processing functions. 